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SUMMARY 


This report contains the results of an investigation carried out for 
the Langley Research Center Terminal Configured Vehicle (TCV) Program. 

The investigation generated and compared three path update algorithms de- 
signed to provide smooth transition for an aircraft guidance system from 
DME, VORTAC, and barometric navaids to the more precise MLS by modi- 
fying the desired 3-D flight path. The first, called the Zero Cross Track, 
eliminates the discontinuity in cross track and altitude error by designating 
the first valid MLS aircraft position as the desired first waypoint, while 
retaining all subsequent waypoints. The discontinuity in track angle is left 
unaltered. The second, called the Tangent Path also eliminates the discon- 
tinuity in cross track and altitude and chooses a new desired heading to be 
tangent to the next oncoming circular arc turn. No attempt is made to elim- 
inate the track angle error. The third, called the Continued Track, eliminates 
the discontinuity in cross track, altitude and track angle by accepting the 
current MLS position and track angle as the desired ones and recomputes the 
location of the next waypoint. The Zero Cross Track and Tangent Path schemes 
may only be used while flying along a straight line segment while the Continued 
Track scheme will reconstruct the path while on a circular turn segment. 

A method is presented for providing a waypoint guidance path construction 
which treats turns of less than, and greater than, 180° in a uniform manner to 
construct the desired path. This method, when used in conjunction with the 
Continued Track method, may be used to reconstruct a smooth transition path 
to landing at every position in the terminal area including during turns . 



INTRODUCTION 


The use of MLS precision navaids in the terminal area generate transition 
problems in automated navigation and guidance for aircraft for systems which 
track RNAV paths defined by preset wa 5 ^oints. These problems are described 

* *5t: 

in Refs. 1 and 2 along with suggested fixes and simulation studies of typical 
aircraft terminal approach patterns. This report develops the equations for 
three competitive Path Reconstruction Algorithms, using typical waypoint 
techniques in use on the TCV B-737 aircraft and similar commercial and 
military airplanes. 

A simulation study of the performance of these comparative algorithms 
is carried out and the resulting data are displayed. A separate appendix der- 
ives a Path Construction Method which treats turns of less than 180° and 
greater than 180° in a uniform and precise manner. The method makes possible 
a solution of the transition problems at every position in the terminal area, 
including during turns, and provides for a smooth landing approach with minimal 
redesign of the original path by eliminating the cross track, track angle, and 
altitude errors at the acquisition of the first complete valid MLS position. 


1. Pines, S.; Schmidt, S. F. ; and Mann, F. : Automated Landing, Rollout, 
and Turnoff Using MLS and Magnetic Cable Sensors. NASA CR-2907 , Oct. 1977. 

2. Pines, S. : Terminal Area Automatic Navigation, Guidance, and 
Control Research Using the Microwave Landing System (MLS). Part 2 - RNAV/MLS 
Transition Problems for Aircraft. NASA CR-3511, 1982. 
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I. 


PATH RECONSTRUCTION ALGORITHMS 


A. General Comments 

The method for constructing a path for RNAV guidance is given 
in Reference 1. The path is completely defined given the following data: 

1) N, the integer number of waypoints designating the start, 
tenuination, and all interior corners at which turns are 
required. 

2) X (I) , the longitude, and 6 (I) , the latitude of each waypoint. 

3) h (I) , the height above the earth reference sphere, and Vj^(I) , 
the desired airspeed at each waypoint. 

4) R^(I) , the turn radius, at each interior waypoint. 

These data, following the logic in Reference 1, yield a series of path 
segments, consisting of straight lines and turns, which completely define the 
desired position and velocity of the aircraft. 

In developing a path reconstruction algorithm at RNAV/MLS transition, 
the competing methods each redefine a small number of waypoints, altitudes 
and desired velocities , and utilize the existing navigation structure to redefine 
the desired path. The objective is to minimize the aircraft maneuvers in the 
lateral and vertical directions at transition without unduly invading the originally 
designated airspace of the initial flight plan in the terminal area. 

Three algorithms will be developed here. They are: 

1) Zero Cross Track 

2) Tangent Path 

3) Continued Track 

All three eliminate the transition error in altitude and desired airspeed. The 
first also eliminates the cross track error. The second eliminates the cross 
track error but retains the location of the center and the radius of the next 
turn. The third eliminates both the cross track and the track angle error. The 
algorithms for the three competing methods are given below. 
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In addition to the above, in order to accommodate turns greater than 
180° it is necessary to alter the structure of the path construction routine in 
order to allow the alternative of designating the center of the turn as an interior 
waypoint in place of the interior corner. The equations for these changes are 
contained in Appendix I. 

B. Zero Cross Track (ZCT) 

The algorithm for this transition path reconstruction is contained 
in Reference 1 and is included here only for the purpose of convenience of 
comparison. (See Hgure 1). 

To begin, we note that the algorithm cannot be implemented in a turn 
nor can it be used if the MLS position lies within the turn circle. Furthermore, 
even if we are outside the turn radius, but too close to the incoming turn circle, 
large errors in track angle result and the advantage of a smooth transition is 
lost. In order to avoid these adverse effects we include a test for the minimum 
allowable distance from the initial turn circle center to execute the ZTC 
algorithm. 

Let RE be the position vector of the aircraft in the Fixed Earth Inertial 
Coordinate System, obtained from the valid MLS update at transition. Let N be 
the number of waypoints in the initial flight plan. Let P be the number of the 
last interior waypoint passed in the flight. For example, on the initial leg of 
the aircraft trajectory, P = 1; after passing the middle of the first turn, 

P = 2, etc. 

A 

Let CR(P) be the unit vector to the center of the oncoming turn. The 
distance from the aircraft to the center of the turn is given by 

DTEST = r„ (sin 1 RE x CR (P) | ) (1) 

x!v 

r^ = the radius of the earth. 


where 


and 
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PI ( 2(P+1) - 1 ) 


OLD 


PI (1) 


NEW 


• CR(P+1) 


OLD 


CR(1) 


NEW 


WN(1) 


NEW 


WN (P+2) = WN (2) 

' ^OLD ' 'new 


WR WR 


WN(P+1). 


WR(1) = RE (MLS) 


Figure 1. Zero Cross Track Construction 


If DTEST > R^(P)+D(ZTC) we execute the ZTC algorithm below. 
The value of D (ZTC) is preset in bulk storage and is usually taken to be 
I R^(P). If the test fails we execute the continued track algorithm (CT) with 
a message that the ZTC test has failed. 


We set 

X (1) = 
6 ( 1 ) = 
h(l) = 


-1 

A 

tan 

( - (2) 

. -1 

A 

sm 

( Rg (1) ) 

R 

“ 

E ‘ 

E 


A 

/ R^ (3) ) ff/180 
n/180 


(2a) 


Vd(1) - 


current desired airspeed in knots 


To fill out the remainder of the path input block data, we set 


and 


X (I) = X (P + I) 

6 (I) = 6 (P + I) 
h (I) = h (P + I) 
Vd(I) = (P + I) 

if N-P + 1 s 3 


I = 1 , N - P 


(2b) 


\ (I) = (P + I-l) I = 1 , N - P - 1 (2c) 

A 

We note that while the oncoming interior waypoint, WR (P + 1) , is retained, 

A 

the unit vector to the center of the oncoming turn, CR (P) , is moved. Figure 1 
illustrates a typical ZCT path construction. The logic for constructing the 
altered path, and the guidance parameter computation is identical to that used 
in generating the original path and is contained in Reference 1. The total number 
of waypoints in the reconstructed path is J = N-P + 1. 
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C. Tangent Path (TP) 


The algorithm for the tangent path construction assigns the initial 

A A 

waypoint, WR (1) , to the unit position vector of the aircraft , WE , and 

A 

chooses the second waypoint, WR (2) so that the great circle determined by the 

A A 

plane containing WE and WR (2) shall be tangent to the existing oncoming 


turn circle with the unit center vector, CR (P) , and turn radius , R (P). We 

A T 

proceed to determine the new first interior waypoint j WR (2) . 

A 

Let M be the unit normal to the great circle plane containing the 

A A 

present position, WE , and the center of the circle, CR (P). 


M 


RE X CR (P) 

—K X 

RE X CR (P)| 


(3) 


A A 

The unit normal , WN (1), to the great circle plane containing RE 


and the 

A 


oncoming unit tangent vector , PI (1) , may be obtained by rotating , M , 

A 

about RE through an unknown angle , . We have 


A A A ^ 

WN (1) = cos a M + sign (Ai^) sin CT RE x M (4) 


To determine the angle a we resort to spherical trigonometry (see 
Fig. 2) 

sin (Rrp(P)/rg) 

sinff = —X R 

I RE X CR (P) I 

(5) 

cos or = ^1 - sin^ CT 
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To determine the new first interior waypoint , WR (2) , we note that 
it is determined by the cross product of the incoming and outgoing normals. 
Since the remainder of the path past the oncoming turn is left unaltered, we 
have 


WN (2) = WN (P + 1) 


and 


WR (2) = - sign (A0) 


WN (1) X WN (2) 

r' 

I WN (1) X WN (2) 


To obtain the block data information for the tangent path we set 

X (1) = tan" ( - RE (2) / RE (3) ) tt/180 
-1 '' 

6 (1) = sin (RE (1) ) Tt/180 

h (1) = I Re I " ^E 

Vj^(l) = current desired airspeed in knots 


( 6 ) 

(7) 


(8a) 


Let 

A A 

A = WR (2) 

then, for the second was^point, we have 

X (2) = tan" ( - A (2) / A (3) ) 
6 (2) = sin"^ (A (1) ) 
h (2) = h (P + 1) 

Vd(2) = (P + 1) 


(8b) 


9 


Ill 


For the remainder of the block data we set 

X (I) = X (P + I) 

6 (I) = 6 (P + 1) 

h (I) = h (P + I) I = 2, N - P (8c) 

Vj^(I) = (P + I) 

and if N-P + 1 s3 

(I) - R^ (P + I-l) I = 1, N - P - 1 (8d) 


As in the case of the Zero Cross Track method, the Tangent Path Tran- 
sition Technique eliminates the cross track error and the command altitude error, 
but does not eliminate the track angle error- Consequently, if the transition takes 
place too close to the oncoming turn circle, a large track angle error is produced 
along the new path and large turn commands may result. Here again, it is recom- 
mended to defer using the TP method if the distance to the center of the oncoming 
turn is too close. 


Let PTEST be computed as 

-It'' ^ I 

PTEST = r„ (sin | RE x CR (P) 1 ) 


(8e) 


If DTEST > R^ (P) + D (TP) we execute the TP procedure. Otherwise, we 
call for the continued track method (CT) and display a message to that effect to 
the pilot. 
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D. Continued Track (CT) 


The Continued Track transition method accepts the MLS position and 
velocity vectors, thus eliminating the need for corrections at transition. More- 
over it is capable of being executed along a great circle (straight line path) or in 
a turn and thus provides a truly smooth transition. 

Let RE be the aircraft position vector in the earth fixed inertial 
coordinate system, and RE be the aircraft velocity vector in the same system. 
Then, the unit normal to the first aircraft reconstructed path is given by 


W (1) 


RE X RE 
RE X RE 


(9) 


At this juncture it is necessary to introduce the ability of utilizing either 
an interior comer or a center of turn as an input waypoint in the initial block 
data. This is done in order to accommodate turns of greater than 180 degrees. 
The addition is introduced in Appendix I of this report. An array, IC (I) , is 
created in block data. For each waypoint we choose either IC (I) = 0, or 
IC (I) = 1. 


If IC (I) = 0 , 

then X (I) , 6 (I) correspond to a regular interior waj^oint* 
If IC (I) = 1 , 

then X (I) , 6 (i) correspond to a center of turn waypoint. 

In addition, we must assign to each turn a 
the turn is in the direction of increasing azimuth 
SIGN (I) = 1. , or decreasing, SIGN (I) = -1. 


(10a) 


(10b) 


SIGN (I), indicating whether 
with respect to north. 
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For the first waypoint, following a valid MLS update, we set 


IC (1) = 0 

X (1) = tan“ (- RE (2)/ RE (3) ) ff/180 

-1 ^ 

6 (1) - sin (RE (1) ) ir/l80 

h (1) = I RE I - r^ 

Vj^(l) = current desired airspeed in knots 
SIGN (1) = SIGN (P) 


( 11 ) 


1. CT on a straight line segment 

If the aircraft is not in a turn, we determine the second interior 
way point using Eq. (2), 


WR (2) = - SIGN (P) 


WN (1) X WN (P+1) 

A A 

|WN (1) X WN (P+1) I 


( 12 ) 


A A 

Let a be the sign of the vector dot product of WR (2) and CR (P), the 
turn center of the original oncoming turn. 


A A 

CT = Sign (WR (2) • CR (P) ) 


(13) 


Then, the new unit vector to the center of the first oncoming turn, CR (1), is 
given by 


CR (1) = 



2 

2 sin A 

A A 

1+ WN(1) • WN (P+1) 


WR (2) - 


sin A 


1+ WN(1) • WN(P+1) 


(WN(1)+WN(P+1)) 

(14a) 


where sin A = sin (R^(P) / r^ ) 


(14b) 
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In addition, set 


h(2) = h(P) 

(15a) 


(15b) 

IL = P 

(15c) 

2. CT in turn 



If transition takes place during a turn we must set the 
trigger, ITURN , to infoimi block data that the first straight line segment should 
be eliminated in generating the new path. 

The second item to be determined is whether we are in the first half of 
the turn or the second. If we are in the first half of the turn, it is a relatively 
short distance to the middle of the turn. Since we have accepted the existing 
aircraft altitude as the desired altitude, we must alter the desired altitude at 
the middle of the turn to avoid an abrupt change in glide slope over the short 
distance remaining. This is accomplished in the path generation logic (see 
Appendix I). If we are in the second half of the turn there is little danger of an 
abrupt change in desired glide slope since the next altitude is defined at the 
middle of the next turn, which is usually some distance away. 

The third item to be determined is whether we are in the final turn prior 
to landing. It is necessary to know this for the following reason. If we are in a 

A 

turn we know that the unit position vector, RE , lies on the turn circle and we 

A 

know the unit normal, WN (1). Together with the radius of the turn, R^ (1), 
and the SIGN (P), these items completely determine the unit vector to the center 

A A 

of the turn, CR (1). The location of the center, CR (1), and the unit vector to 

A 

the center of the next turn CR (2), together with their radii, Rr_(l) and R (2), 

X A J. 

and their SIGN'S, completely determine the outgoing unit normal vector, WN(2). 
However, on the last leg, leadii^ to touchdown, we are not free to choose the 

A 

outgoing unit normal, WN (2), since this is determined by the heading of the 

A 

runway, 0R , and the final waypoint , WR (N). Consequently we must surrender 
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a degree-of-freedom to accommodate the final straight line leg. We choose 
to give up the radius of the turn, R^(l). 

The sequence of the choices proceeds as follows: 

If we are in a turn, we set, 

ITURN = 1 (16a) 

Otherwise, ITURN is defaulted to 0. 

If we are in the turn and it is the first half of the turn, then we set 

IMOD = 2 (16b) 

GRX = GRAD (P) (16c) 

Otherwise, these are defaulted to be IMOD = 1 and GRX = 0. 

The path generation logic will use these triggers to eliminate the first straight 
line segment, and to determine the altitude at the middle of the turn to provide 
for a continuous glide slope. 

In addition we set 


M = N - P + 1 

(16d) 

IL = P 

(16e) 


If we are in a turn and in the second half of the turn, then we set 


IMOD = 0 

(16f) 

M 

= N - P + 2 

(16g) 

IL 

= P - 1 

(16h) 
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Now we check if we are on the last turn. If M = 3, we must determine 


the radius of the turn. 

For this case we have 

A A 

A1 = WN (N-1) • RE (17a) 

A A 

A2 = 1. - WN (1) • WN (N-1) (17b) 

sin A = JiAlf + (A2)2 (17c) 

Rrr(l) = ^ 

i tj 


If M > 3 we set 

R^Cl) = R^aL) (17e) 

For all the above cases we proceed to deteimiine the unit center of the new 
turn. Let 


sin A 


. -1 
r sin 
E 


(IU(1)/ ) 

E 


2 2 

cos A = (1. - (sin A) ) 


CR (1) = cos A RE - sign (Ail)) sin A WN (1) 


(18a) 

(18b) 

(19) 


3. CT Block Data for all cases 

Having determined the unit center of the turn for all three 

CT cases, we set 


A A 


A = CR (1) 


(20) 

IC (2) = 1 


(21a) 

X (2) = tan“^ 

A A 

(-A (2) / A (3) ) ir/180 

(21b) 
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(21c) 


-1 

6 (2) = sin (A (1) ) ff/180 

h (2) = h (P+1) (21d) 

V = V (P+1) (21®) 

D D 
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n. SIMULATION STUDY OF THE COMPARATIVE PATH RECONSTRUCTION 
METHODS 

A. Description of the Simulation Test Data 

This section contains the plots of computer runs carried out using 
the FILCOMP program. Each run consists of 3 sets of plots. 

The first in each series contains a plot of the aircraft ground track illus- 
trating the original and reconstructed paths. The original waypoint data point 
is indicated by a point enclosed by a diamond. The reconstructed waypoint is 
marked by a point contained in a circle. The boundary limits of the MLS 
azimuth antenna are illustrated by a dashed line emanating from the azimuth 
antenna. The boundary limits of the elevation antenna are illustrated by a 
dashed line emanating from the antenna site to the right of the start of the run- 
way. The initial waypoint at the start of each trajectory is shown by a point 
enclosed in a diamond. Transition occurs immediately after entering the 
elevation coverage. If the center of a turn is relocated during path recon- 
struction, both the original and new center are shown. If the tangent path 
method is used, the center of the turn is not altered, but the vertex corner may 
be altered, and both the original and the reconstructed vertex are shown. Per- 
tinent data requiring winds. Path Construction Algorithm used, navigation filter 
t3T5e, etc. , are printed on this page. Finally, to illustrate the remaining distance 
to touchdown, each plot contains either the original path design approach distance 
in nautical units, or the reconstructed final distance. 

The second page in each series contains 7 plots of pertinent data as a 
function of time. These consist of the following: 

1) Glide path deviation in meters for both the true deviation and the 
estimated deviation for the particular navigation filter in use in the guidance 
loop for aircraft control. 

2) Aircraft pitch angle in degrees for the true pitch, the measured 
pitch output of the IMU (used by the complementary filter) and the estimated 
pitch corrected for the estimated gyro drift bias (used in the Kalman filters). 
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3) Aircraft altitude rate, measured in meters per second, for 
both the true rate of climb and the estimated rate obtained by the particular 
navigation filter supplying the control equations. 

4) , 5), 6) Errors in the estimate of the forward, lateral and 
vertical coordinates of the aircraft measured in the flat earth runway coor- 
dinates of the aircraft measured in the flat earth runway coordinate system 
for both the complementary and Kalman filters, measured in meters. 

7) Error in the estimate of the forward velocity component 

A 

in the runway coordinate system, measured in meters per second for 
both the complementaiy and the Kalman filters. 

The last of the figures in each series of three contain 8 plots of data as 
function of time. These consist of the following: 

1) Cross track error, measured in meters, for both the true 
CRTE and the estimated CRTE obtained by the navigation filter used to 
supply the guidance equations. 

2) Track angle error, converted from degrees to the time rate of 
change of cross track error by multiplying by the ground speed. Both the true 
track angle error and the estimated track angle error supplying the guidance 
equations are shown, measured in meters per second. 

3) Aircraft roll angle, measured in degrees, for the true roll angle, 
the measured roll angle supplying the complementary filter, and the measured 
roll angle corrected for the gyro drift bias (used in the Kalman filter estimate of 
the aircraft roll angle). 

4) Error in the estimate of the north component of the wind, in meters 
per second, for both the Kalman and complementai^?^ filters. 

5) Error in the estimate of the west component of the wind, in meters 
per second, for both the Kalman and complementary filters. 

6) Difference between the true desired airspeed and the true airspeed. 
A second plot also shows the difference between the true ground speed and the 
true airspeed. The curves are mirror images of one another in the event the 
winds are zero, and differ in the presence of winds. 
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7) Error in the estimate of the lateral velocity x , in the 

2R 

runway coordinate system, in meters per second, for both the Kalman and 
the complementary filter. 

A 

8) Error in the estimate of the vertical velocity, x , in the 
runway coordinate system, in meters per second, for both the Kalman and 
the complementary filter. 

B. Discussion of the Results 

Case 1 illustrates a successful application of the tangent path tech- 
nique. In this case transition occurs sufficiently far away from the oncoming 
turn circle so that the uncorrected error in track angle does not cause an ex- 
cessive roll. Fig. 3(a) shows the ground track for this case. Transition occurs 
40 seconds after the start of the simulation immediately after the aircraft enters 
the elevation coverage. The large sweep of 75° permits the aircraft to update 
the path on the straight line portion fully 15 seconds prior to the start of the turn 
at a distance of over 1100 meters. The maximum roll angle needed to erase the 
uncorrected track angle error is shown in Plot 3 of Fig. 3(c) and is seen to be 
approximately 3 °. This occurs sufficiently far away from the required turn so 
that the aircraft has time to level off before executing the turn. 

Case 2 illustrates a less successful application of the tangent path recon- 
struction technique. In this case (Fig. 4(a)), transition occurs after the com- 
pletion of the first turn and prior to the start of the second turn. The aircraft 
guidance is presented with a large track angle error (see Plot 2, Fig. 4(c)). A 
roll angle of 10 ° is required to regain the heading alignment. (See Plot 3, 

Fig. 4(c)). Since this follows the exit of the previous turn, an undesirable 
sequence of turns result. 

Case 3 illustrates the advantage of the continued track path construction 
over the tangent path method. In this case, the same transition geometry 
Fig. 5(a)) results in a smooth path without extra turns. The center of the on- 
coming circle is only slightly altered to accommodate the elimination of the error 
in cross track and track angle. Plot 1 and 3 of Fig. 5(c) shows no cross track 
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error or roll angle following the transition time at 110 seconds. The superiority 
of the continued track over the tangent path reconstruction method is clearly 
illustrated. 

Case 4 is a further illustration of the undesirability of utilizing the tangent 
path when the aircraft is too close to the oncoming turn circle. In this case (see 
Fig. 6(a) ) the elevation coverage limits are set at 35°. The change in heading 
required to produce a path tangent to the oncoming circle produces an error in 
cross track rate of over 20 m/sec (see Plot 2, Fig. 6(c) ) and a roll angle of 20 
(see Plot 3, Fig. 6(c)). This is immediately followed by the onset of the required 
turn, which causes an undesirable series of turns. 

Case 5 shows the identical transition history with the continued track algor- 
ithm. Once again, with a slight adjustment of the center of the oncoming turn, the 
cross track and these track angle errors are eliminated and no extra maneuvering 

oceurs. Fig. 7(a) shows the smooth ground track. The altered center of the 
second turn is indicated by the small circle in the center of the turn. It ^ould be 
noted that the last outgoing tangent point, at the intersection of the second circle 
and the runway track, has been moved forward somewhat, but that the remaining 
ground distance to touchdown is still 1. 80 nautical miles; long enough to permit 
a normal landing. 

Cases 6, 7, 8, 9, and 10 illustrate the adaptability and applicability of the 
continued track reconstruction technique at every point along the approach flight path. 
By varying the boundary limits of the elevation coverage it is possible to force 
the transition point to occur at a straight line segment on the first half or second 
half of a turn, and either the first or the final approach turn. Each case is handled 
successfully, without requiring any extra roll to recapture the original path. 

Case 6, Figs. 8(a), 8(b), and 8 (c) illustrate the application of the continued 
path with transition occurring on the straight line segment immediately prior to 
the onset of the first turn. Plots 2 and 3 of Fig. 8(c), show little cross track 
velocity after transition and no roll angle required until the start of the reconstructed 
first turn. 

Case 7, Figs. 9(a), 9(b), and 9(c) illustrate the application of the continued 
track technique when transition occurs on the first half of the first turn circle. 
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Once again, examination of Plots 2 and 3 of Fig. 9 (c) shows the elimination of the 
cross track velocity in the middle of the required turn and no extra roll angle 
is called for whatsoever. It should be noted that a small change in the relocation 
of the center of the second turn is required, resulting in a small movement (. 08 
nautical miles) of the outgoing tangent point along the runway extension segment. 

(See Fig. 9(a)). 

Case 8, illustrates the same smooth continued path reconstruction when 
transition occurs on the second half of the first turn. (See Figs. 10(a), 10(b), and 
10(c) ). 

Case 9, Figs.ll(a), 11(b), andll(c) illustrate the continued path reconstruc- 
tion when transition occurs on the first half of the last turn. The only significant 
feature here is the need to change the radius of the last turn and the movement of 
the tangent to the runway centerline to a point 1. 79 nautical miles from touchdown. 

Case 10 illustrates the most critical of all transitions. This one takes place 
on the second half of the final turn. A smooth transition occurs again. The only 
significant problem is the shortening of the final approach segment, from the 
tangent point to touchdown from its initial value of 2 nautical miles to 1.47 nautical 
miles. There appears to be no reason why a successful smooth letdown cannot 
be executed in this remaining distance. Plot 6, Fig. 12 (b) illustrates the readjust- 
ment in the estimate of vertical height at transition. Plot 2, Fig. 12(b), illustrates 
the smooth pitch profile. It is interesting to examine Plot 2, Fig. 12 (c). The roll 
angle following transition is lowered from 15 ^ to 10 ° to accommodate the increase 
in the altered turn radius. 

Cases 11 and 12 are illustrations of the capability of path construction for 
turns greater than 180°, and the ability of the continued path to reconstruct a path 
greater than 180° on the first and second half of a final turn. 

Case 11, Fig. 's 13(a), 13 (b) , and 13(c) represent an approach path with a 
220° turn into the final runway segment. Transition takes place shortly before 
the aircraft has entered the first haK of the turn. Fig. 13(a) shows the recon- 
struction of the turn circle, including the determination of the new turn radius. 

Once again, the outgoing tangency point with the final runway segment has been 
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altered from 2. 0 nautical miles to 1.67 nautical miles. A successful landing is 
accomplished without undue maneuvering. 

Case 12, Figs. 14(a), 14(b), and 14(c) represent the same 220° turn 
approach with the transition occurring on the second half of the turn. Once 
again, the change in turn radius at transition calls for a somewhat smaller roll 
angle as seen in Plot 3, Fig. 14(a). Examination of Plot 3, Fig. 14(b) illustrates 
a slight oscillation of the vertical altitude rate following the transition time. This 
oscillation is inherent in the pitch chaimel due to coupling between the engine 
thrust and the error in desired airspeed. 
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TABLE I 


VORTAC AND MLS STATION COORDINATES 


VORTAC STATION COORDINATES 


STATION LONGITUDE 
STATION LATITUDE 
STATION ALTITUDE 


40. 40316 
-27.164894 
45. 72 m 


MLS STATION COORDINATES 

AZIMUTH & DME LONGITUDE 40.25 

AZIMUTH & DME LATITUDE -77.025 

AZIMUTH & DME ALTITUDE 0. 

ELEVATION DISTANCE FROM RUNWAY COORDINATE FRAME ORIGIN 
XEL(l) = 1000., XEL(2) = 254.78, XEL(3) = .47 

RUNWAY HEADING = 30 ^ 
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TABLE n 


INPUT DATA FOR WAYPOINT CONSTRUCTION 
CASES 1 THROUGH 10 


N = 4 


I 

X(l) 

6(1) 

h(I) 

vna) 

IC 


DEG 

DEG 

m 

m/sec 


1 

40.29759451 

-77. 14538380 

994. 654 

74. 594 

0 

2 

40. 23788553 

-77.13148869 

640.811 

69. 450 

0 

3 

40.20574384 

-77.05845224 

290. 748 

64.305 

0 

4 

40.25237254 

-77.02320521 

0. 

64.305 

0 
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Aircraft Ground Track 


Fig. 5(a) CASE 3 
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TABLE in 

INPUT DATA FOR WAYPOINT CONSTRUCTION 
CASE 11 & 12 


N = 3 


I 

X(I) 

m 

h(I) 

Vd(I) 

IC 


DEG 

DEG 

m 

m/sec 


1 

-77.0268144 

40. 26663483 

897. 59 

74. 594 

0 

2 

-77.0683161 

40. 23380727 

452.04 

69.450 

1 

3 

-77. 1453838 

40.29759451 

0. 

64.305 

0 
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Aircraft Ground Track 


Fig. 13(a) CASE 11 
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APPENDIX I 


Uniform Waypoint Path Construction 

This appendix derives the equations for constructing a desired path, 
consisting of straight lines (great circles) connected by arcs of circles of a 
fixed radius. The resulting continuous path is located on the surface of a 
rotating, spherical earth. The connecting turn circles may be less than or 
greater than 180° in arc length, and are limited only to be less than 360°. The 
required input data consist of the latitude and longitude of a sequence of way- 
points, the radius of each turn circle and the sign of the turn, the desired 
altitude and airspeed at each waypoint, an integer code designating whether 
each waypoint is regular waypoint, or the center of the turn, an integer 
variable indicating whether the initial point is the start of a straight line seg- 
ment or on a turn, and the integer total number of waypoints. Given N way- 
points there are only N-2 turns. 

A. Initial Data 

Let N be the number of waypoints (N must be at least three). At 
each waypoint we must supply the following: 

Fori = 1, N 

X (I) = longitude in degrees 

6 (I) = latitude in degrees 

h (I) = height above the sphere in meters (2. 1) 

Vj^(I) = desired airspeed in meters/sec 
IC (I) = 0 if waypoint is regular 

1 if waypoint is center of turn 

For 1 = 1, N-2 
R^(I) = radius of turn 

SNDP (I) = sign of turn (2.2) 

1 for clockwise, -1 for counter clockwise 
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For the first waypoint 


ITURN = 0 means the initialization starts on a straight 

line segment (2.3) 

ITURN = 1 means the initialization starts in a turn. 

This is used only on reconstruction, if 
the update is to take place on a turn. 


B. Vector Representation of Each Waypoint 

The vector representation of each waypoint is in the earth fixed 
system. Converting the angle data into radians, the waypoint unit vectors 
are given by 


Fori = 1, N 

r 


WR (I) = 


sin 6 (I) 

-cos 6 (I) sin \ (I) 
cos 6 (I) cos X (I) 


(2.4) 


C. The Unit Normal Vectors 

Between each consecutive pair of waypoints construct a plane. 

If IC (I) = 0 and IC (I+l) = 0, then the plane is the plane containing the two 
vectors, and the unit normal to that plane is given by 


WR (I) X WR (I+l) 


(2.5) 


If IC (I) = 0, and IC (I+l) = 1, then we are going from a normal point to a 
circle, and we construct the plane which contains the first waypoint and is 
tangent to turn circle of the given radius, R.^,. Since there are two tangent 
planes from a point to a circle, the sign of the turn removes the ambiguity. 
In a manner simular to Eq. (2. 5) we first form the plane from the regular 
waypoint to the center of the turn. The unit normal to that plane is given by 


XN 


WR (I) X WR (I+l) 
WR (I) X WR ( 1 + 1)1 


( 2 . 6 ) 
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To obtain the unit normal to the plane tangent to the turn, we must rotate 

A ^ 

the imit normal , XN , about the waypoint vector WN (I) through the angle, 

A A 

A , formed by the plane between WR (I) and WR (I+l), and the plane between 

A ^ 

WR (I) and the tangent wa 3 ^oint at the circle , PI (21 - 1), (see Fig. II). 

To obtain the angle A , we have from spherical trigonometry 


sin R = 

A A 

WR (I) X WR (I+l) 

(2.7a) 

cos ^ = 

A A 

WR (I) * WR (I+l) 

(2.7b) 

sin a = 

sin (Rp(I) / r^ 

(2.7c) 

cos a = 

a/i - sin^ a 



A A 

If ITURN = 1, and we are in the turn, then WR (I) is PI (21-1), and 
we set 


sin p = sin a 
cos jS = cos a 
cos A = 0 
sin A = 1 


(2. 7d) 


Otherwise we have 

sin A = sin a/cos ^ 
cos A = //l~- sin^ A 

A 

The desired equation for WN (I) is given by 


(2.7e) 


WN (I) = cos A XN + sin A sign (A0 (I) ) WR (I) x XN (2.8) 


If IC (I) = 1 and IC (I+l) = 0, then we require the plane containing 
the outgoing tangent point, PI (21) and WR (I+l). Again we form the plane 
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sign (Aj/)) = +1 




UNIT NORMAL IC(I) = 0, IC(I+1) = 1 


Figure II 
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sign (Atp) = +1 




UNIT NORMAL IC(I) = 1, IC(I+1)= 0 
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Figure 12 














containing WR (I) and WR (I+l), construct the unit normal XN and rotate 

A A 

XN about WR (I+l), through the negative of the angle A. (See Fig. 12). 

For this case we retain Eq. (2.6), Eq. ’s (2.7a) and (2.7b). However, 


sin a = sin (Rj, (I-l)/r^) 

(2.9a) 

cos a = //l - sin^ 01 

(2.9b) 

. . sin a 

sin A = - ^ 

cos j8 

(2.9c) 

cos A = Jl - sin^ A 

(2. 9d) 


and the desired unit normal is given by 


WN (I) = cos A XN + sin A sign (A0 (I-l) ) WR (I+l) x XN (2.10) 


The reason for using R^ (I-l), and A0 (I-l) is that we are on the 
outgoing leg and the turn circle we refer to is behind us not ahead. 

One more precaution is required. In the event N is 3 and we have 
chosen to construct a path starting in the turn, then we are no longer free to 
choose a radius because the outgoing unit normal must be parallel to the run- 
way unit normal. Consequently, if IC (I) = 1, and IC (I+l) = 0, and N = 3, 
we are compelled to compute the outgoing normal to be parallel to the runway 
normal and we must compute the radius of the turn to be consistent with this 
outgoing unit normal. 

For this case, if IC (I) = 1 and IC (N) = 0, the unit normal to the 
runway is given by 


where 


WN = cos }j) N - sin tp WR (N) x N 
R R 


f cos 6 


N 


(N) 


( 2 . 11 ) 


(2. 11a) 


0 


R 


and 


= < sin 6 (N) sin X (N) > 

Ijsin 6 (N) cos X (N) J 
is the runway azimuth in radians 
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If IC (I) = 1 and IC (I+l) = 1, then the required path must be a great 
circle tangent to two circles. To obtain the unit normal to this common plane 

A A 

we require R^(I) , (I+l). WR (I) , WR (I+l), sign (A0 (I) ) and sign (A 0(1+1). 

The unit normal is given by 


A A A A A 

WN (I) = a^ WR (I+l) + ag WR (I) + a^ WR (I) x WR (I+l) (2. 12) 


where 

, 2 

a. = (cos sin a - sin a„) / sin 0 

-L J. lU 

2 

a^ = (cos 0 sin - sin / sin ^ (2. 12a) 

a^ = (cos cos Oi^ siny ) / sin^ 0 


sin 0 = WR (I) X WR (I+l) 

1 

2 2 

cos 0 = (1 - sin 0) 


(2.12b) 


sin ey^ = sin (R^(I) / r^) 
sin ttg = sin (R^(I+1) / r^) 

siny = I PI (21) x PI (21+1) | (2.12c) 

cos y = (cos 0 - sin sin a^) / (cos cos c^) 

2 ^ 

sin y = (1 - cos y) 


See Fig. (13). 

This exhausts all the possible unit normals for any pair of consecutive way 
points . 


D. Center of Turn Unit Vector 

The unit vector to the center of turn is defined in one of two ways. 
Either , the center is itself a waypoint, or else it may be computed given the 

A A 

incoming and outgoing unit normals, WN (I), and WN (I+l), the radius of the 
turn, Rp (I), and the sign of the turn, sign ( A0 (I) ). 
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sign (A0(I) ) = 


sign A0(I) = 


WN(I) 



A A 



UNIT NORMAL IC(I) = 1, ICa+1) = 1 
Figure 13. 
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If IC (I+l) = 1, we have 


CR (I) = WR (I+l) (2.13) 


If IC (I+l) = 0, we have 


CR (I) = a, WR (I+l) + a (WN (I) + WN (I+l) ) 

1 A 


where 



2 

2 sin a 


JL 

2 


) 


1. + WN (I) • WN (I+l) 


(2. 14) 


(2.14a) 


a = - sin a sign (Aij) (I) ) 

^ A A 

1. + WN (I) • WN (I+l) 


sin a = sin (RT(I)/r 

E 

E. Turn Angle 

A 

The unit vector to the center of the turn, CR (I) , and the incoming normal, 

A A 

WN (I) determine a plane which contains the unit vector, PI (21-1), which is at 
intersection of start of the turn and the incoming great circle. We define a 

A A A 

unit vector YN , which lies in the CR (I) , WN (I) plane and which is per- 

A 

pendicularto CR (I) . 


YN 


WN (I) + CR (I) 

cos a cos a 


(2. 15) 


where 

sin a = sin (RT(I) / r 

E 


(2.15a) 


We define, the turn angle. All) (I)» or the angle through which we must 

A A 

rotate YN , about the unit vector, -CR (I) , in order that the rotated unit 

A A 

f 

vector, YN , will lie in the plane containing the unit center of the turn, CR (I), 

A 

and the outgoing normal, WR (I+l). (See Fig. 14). 
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A 


A 


A 


(2.16) 


YN' = cos(A(/)(I)) YN- sin ( Aj/>) CR (I) x YN 


We have 


A A 


cos(A0(I)) = YN • YN' = 


WN(I) ♦ WN (I+l) - sin 0 ! 


2 

cos a 


(2.16a) 


sin ( Am ) = - CR(I) X YN . YN- = - C R (r ) . x . WN(I) ■ WN(M ) 

COS ey 


It follows that the turn angle is given by 


A A A 

^ . -1 - CR(I) X WN(I) • WN(I+1) 

A 0 = tan — — 7 ^ — ^ — 

WN(I) • WN(I+1) - sin a 


(2. 16c) 


It is necessary to use the four quadrant definition of the arc tangent, and since 
the numerical routines that compute this function turn all angles over 180° into 
their negative complement, it is necessary to test for angles over 180°. 

The recommended test is 


sign (A 0(1) ) tan 


-1 - CR(I) X W(I) • '^(I+l) 

A A 2 

WN(I) • WN(I+1) - sin a 


> 0 . 


(2. 16d) 


Thus if the product of the sign ( A0) and the tan ^ (A0) proves to be negative, 
we set 


A0 (I) = tan ^ (A0) + sign (A0) (2 tt) (2.16e) 

F. End of Segment Unit Vector 

A 

The terminal unit vector at end of each great circle, PI (21-1), 
is used in the guidance equations to determine the distance to go to the end of 
the segment. The required unit vector lies in the plane of the center of the turn, 

A A 

CR(I) and the incoming normal, WN(I). 
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We have 


^ I _ A 

1 sin G/ 

^ ^ ^ (2. 17) 

where sin a = sin (R (I)/r ) 

T E 
1 

2 ^ 

cos a = (1 - sin a) (2. 17a) 

In the event that the initial coordinate is on the turn circle, as in the 
case of trajectory reconstruction and ITURN = 1, we have 

A A 

PI (1) = WR(1) (2.17b) 

The start of the next great circle segment on the outgoing leg is 
given by 


PI (21) = 


1 

cos a 


A . ^ A 

sin 

CR(I) + sign Ail) WN(I+1) 

cos a 


(2, 17c) 


G. The Unit Vector Normal to the Turn Circle 


In the turn, the guidance equations require the unit vector normal 
to the turn circle at the end of the middle of the turn, and at the end of the full 

A A 

turn. The first unit vector is obtained by rotating YN about CR(I) through 
the angle, A0 (I )/2 . 


GN(2I-1) = a^ WN(I) + a^ CR(I) + a^ CR(I) x WN(I) 


a 


1 


cos ( ^ -Sjg” > 

2 cos O' 


a 


2 


cos ( 


All) 

2 


sin a 
cos a 


sin ( ^) (^m ) 

' 2 cos a 


(2.18) 


(2.18a) 


73 



WN(I) sign (Aj|)(I) ) 


WN(I+1) sign (A!/)(I) 


Figure I5a 

Incoming End of Segment 


Figure I5b 

Outgoing End of Segment 



Figure I5c 


Middle of Turn Normal to Circle 



To obtain the normal to the turn circle at the end of turn, we have 


GN(2I) = YN' = — CR(I) + ) WN(I+1) (2. 18b) 

cos Gt cos Oi 

(See Fig. 15) 

H. Altitude and Airspeed Gradients 

To determine the gradients in altitude and airspeed it is necessary 
to obtain the length of the arc segments between the vectors at which the 
altitude and airspeed values are specified. There are three types of segments. 

1) The segment covered by the distance, along the surface of the 

A 

earth, between the initial waypoint, WR(1), and the first ineoming tangent, 

A 

PI(1), plus the distance along the turn circle to the middle of the turn, termin- 
ating at GN(1). 

2) All internal segments consisting of the distance along the 
second half of each turn, plus the distance between the outgoing tangent, 

A A, 

PI (21) and the next incoming tangent (PI (21+1), (along the surface of the earth) 
plus the first half of the next turn. 

3) The final segment covered by the second half of the last turn 
plus the distance along the surface of the earth from the last tangent 

A A 

PI (2 (N-1) ) to the final waypoint WR(N). 

Let the distance along each great circle be DW(I). 

DW(1) = sin" ( 1 WR(1) X PI(1) I ) r^ (2.19a) 

Let 1=1, N-3 (N > 3) 

1 = 1+1 

DW(J) = sin" ( I PI(2I) X PI (21+1) ] ) r^ (2.19b) 
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The final, DW(N-1), is given by 


^ A A 

DW(N-l) = Sin" (PI(2 (N-1) ) x WR(N) ) 


Let the distance along each half turn be XARC(I), we have 


1=1, N-2 

_ A 0(1) 


XARC(I) = 


Rp(I) 


Let the gradient in altitude be GRAD(I), then 


Let 


GRAD(l) = 

I = 1, N-3 
J = I+l 

GRAD(J) = 


h(2) - h(l) 


DW(1) + XARC(l) 


N > 3 


h(J+l) - h(J) 


XARC(I) +XARC(J) + DW(J) 


GRAD(N-1) = 


H(N) - h(N-l) 
XARC(N-2) + DW(N-l) 


Let the gradient in airspeed be DVG(I) , then 
DVG(l) = 


Vd< 2) - Vjj(l) 


Let 


I = 1, N-3 
J = I+l 

DVG(J) = - 


DW(1) + XARC(l) 
N > 3 


Vj^(J+l) - vJJ) 


XARC(I) +XARC(J) + DW(J) 
DVG(N-l) = - 


Vd(N) - Vj^(N-l) 


(See Fig. K) 
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XARC(N-2) + DW(N-l) 


(2.19 c) 

(2.19d) 

(2.19e) 

(2.19f) 

(2.19g) 

(2. 19h) 

(2.19i) 

(2.19j) 



h(l) 


h(2) 


DW(1) XARC(l) 

I6a. GRADIENT IN ALTITUDE 1ST SEGMENT 


1=1, N-3 (N > 3) 
J = I+l 



I6b. GRADIENT IN ALTITUDE INTERNAL SEGMENT 



I6c. GRADIENT IN ALTITUDE LAST SEGMENT 


h(N) 


h(J+l) 


Figure 16 
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In the event ITURN = 1 and IMOD = 2, we are initiating the sequence 
in the turn, we set 

DW(1) = 0. (2.19k) 

Furthermore, in order not to cause an abrupt change in desired gradient, 
we set 


h(2) = h(l)+GRX XARC(l) (2.191) 

In this way we insure that 

GRAD(l) = GRX (2.19m) 

In the event ITURN = 1 and IMOD = 0, we are initiating the sequence 
in the turn, however, since we are in the second half of the turn, the next 
waypoint is some distance away and we are in no danger of causing an abrupt 
change in altitude gradient. In this case we set 


h(2) = h(l) 

DW(1) = 0. 

XARC(l) = Aj/)( 1) r^ 


(2.19n) 


I. Waypoint Guidance Array 

The initial input contains N waypoints. The final path contains 
3N-4 waypoints. These points subtend 3N-5 segments; N-1 of which are 
arcs of great circles and 2(N-2) comprise N-2 pairs of half turns. Each 
segment contains guidance data which are constant over that segment. These 
data are conveniently arranged in 3N-5 guidance arrays which are computed 
initially at the beginning of each flight and called up sequentially, as required. 
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at the start of each segment. The elements for each of the 3N-5 segments are 
listed below for both the great circle arcs and the half turns. 


Let II go from 1 to 3N-5 

J = Integer part of n/3 + 1 
K = 2J - 1 

If MODULO (n,3) = 2 then L = J 

If MODULO (H,3) = 0 then L = J-1 


Array for great circles: 


WP(1) 

= 

A 

WN(J, 1) 

WP(2) 

= 

WN(J,2) 

A 

WP(3) 


WN(J, 3) 

A 

WP(4) 

= 

PI(K, 1) 

A 

WP(5) 

= 

PI(K,2) 

A 

WP(6) 

— 

PI(K,3) 

- 3N-5 
WP(4) 


A 

WR(N,1)\ 

A \ 

WP(5) 

= 

WR(N, 2) 

A 1 

WP(6) 

= 

WR(N,3) J 

WP(7) 

= 

sign (A!/) (J) ) 

A 

WP(8) 

= 

CR(J, 1) 

A 

WP(9) 

= 

CR(J, 2) 

A 

WP(IO) 

= 

CR(J, 3) 

WP(ll) 

= 

DW(J) 

WP(12) 

= 


WP(13) 

= 

0. 

WP(14) 

= 

sin (tan ^ (GRAD(J) ) ) 


( 2 . 20 ) 


(2.20a) 


(2.20b) 
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If II = 1 


^END = H (1) 

\yEND = Vj^(l) 

If n > 1, but < 3N-5 

HEND = HEND + GRAD(J) (r^sin“ (1pI(2J-2) x PI(2J-1)1 ) ) 

•4 A A 

VEND + VEND + DVD(J) (r^sin" (}pi(2J-2) x PI(2J-1) | ) ) 



(2.20c) 


(2.20d) 


If n = 3N-5 
^ ^END = 
\VEND 

WP(15) 

WP(16) 

WP(17) 

WP(18) 

WP(19) 

WP(20) 



= HEND 
= GRAD(J) 
= VEND 
= DVD(J) 

= J 

= |A0(J)/2 


ARRAY FOR HALF TURNS 


If MODULO (H,3) = 2, then L = J 

A 

WP(1) = GN(2L-1, 1) 

A 

WP(2) = GN(2L-1,2) 

A 

WP(3) = GN(2L-1,3) 


If MODULO (H, 3) = 0, then L = J-1 


WP(1) = GN(2L,1) 

A 

WP(2) = GN(2L,2) 

A 

WP(3) = GN(2L,3) 


(2.20e) 


(2. 2 Of) 


(2.21a) 


(2.21b) 
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WP(4) 

WP(5) 

WP(6) 

WP(7) 

WP(8) 

WP(9) 

WP(IO) 

WP(ll) 

WP(12) 

WP(13) 

WP(14) 

HEND - 
VEND = 

WP(15) 

WP(16) 

WP(17) 

WP(18) 

WP(19) 

WP(20) 


= 0 
= 0 
= 0 

= sign (A0(L) ) 

= CR(L, 1) 

= CR(L, 2) 

= CR(L, 3) 

= IA0(L)/2| 

= H^(L) 

= 0 , 

= sin (tan ^ (GRAD(J) ) ) 

HEND + GRAD(J) (R^(L) | Al/)(L)/2 | ) 
VEND + DVD(J) (R^(L) | A(/)(L)/2 | ) 

= HEND 
= GRAD(J) 

- VEND 
= DVD(J) 

= J 

= |A0(L)/2| 


(2.21b) 
(Cont’d. ) 


(2.21c) 
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